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TITEL 



Metod for estimering av massan hos ett fbrdon vilket framfbrs pi en vag med en varierande 
lutning saint metod for estimering av tutningen av den vag dar ett fbrdon framfbrs. 



TEKNISKT OMRADE 

Uppfinnmgen avser en metod for estimering av massan hos ett fbrdon vilket framfbrs pi en 
v&g med en varierande lutning enligt ingressen till patentkravet 1. Uppfinningen avser aven en 
10 metod fbr estimering av lutningen av den vag dir ett fordon framfbrs enligt ingressen till 

patentkravet 13. 1 synnerhet avses en metod fbr samtidig estimating av massa och lutning av 
den vag dar fordonet framfbrs. 



1 5 TEKNIKENS ST ANDPUNKT 



For att sakerstalla att ett fordons rttrelsemOnster kan kontrolleras pi ett tillfiredsstallande vis 
miste tillf&rlitlig information fbr styrning av fordonets drivlina och bromssystem Annas. Av 
avgdrandc betydelse ar att tillfbrlitlig infonnation avseende fordonets massa, dess hastighet 
20 och vagens lutning finns tillganglig 

En vanligt fbrekommande metod for samtidig uppskattning av ett fordons massa och 
lutningen pa den vag dar fordonet framfbrs ar att bcrakna fordonets acceleration vid tvi 
narliggande tidpunkter vilka typiskt sett ligger inom ett intervall pi 0,5 sekunder. Dirigenom 
25 kan gravitationskrafter, nillmotstind och tuftmotstand anses vara konstanta. Genom att nyttja 
Newtons andra lag vid n&mnda tvi matpunkter kan fordonets massa, vilken ir den enda 
obekanta parametem i ekvationen si snart accelerationen beraknats ar uppmatt data om 
hastigheten vid namnda tvi matpunkter. Matsignalen avseende fordonets hastighet ar 
vanligtvis brusig. Far att erhilla en relativt god uppskattning av fordonets acceleration ur den 
30 biusiga hastighetssignalen ar det av vikt att hastighetsskillnaden fir relativt stor trots det korta 
intervallet mellan matpunkterna, Ett sitt att tillhandaballa detta Sr att foriigga den ena 
matpunkten till en tidpunkt strax fore vaxling och den andra tidpunkten strax efter vfixling. Ett 
flertal problem finns dock behiftade med denna metod, Fbr det fflrsta kr&ver dcnna metod att 
mfttningen genomfors under svira fortiillanden eftersom oscillattoner pi grand av drivlinans 
35 flexibilitet och i forekommande fell spelet i kopplingen mellan dragbil och slip. 

Oscillationerna excheras av att drivkraften ar diskontinueriig under vaxUngsforfirandet. 
Vidare kan denna metod inte nyttj as om fordonet ir utrustat med en vaxeUida av si kallad 
; "power-shift** typ dfir frikoppling av kraften fran motorn inte ske* under vaxling. 

: 40 En annan typ av vanligt forekommande vaxellidor ar automaliskt styrda manueUa vixeliidor 
dar sjalva vaxlingsforloppet styrs av stilldon efter valt vixeUige av ©raren. I dessa 
vaxeliador avkanns vaxellaget av en sensor varefter en styrsignal for namnda stalldon 
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effektuerar vaxlingen. Genom denna typ av vaxcllador fir det mbjligt alt under god kontroll 
genomfbra vaxlingsfbrloppet. Ett problem vid vaxling, specielh under fcrd i uppfbrsbacke, ar 
att fordo net tappar fart under vaxlingsfbrloppet eftersom ett avbrott i det fiverfbrda momentet 
uppstar. Detta medfbr att det ar Snskvart att hilla vaxlingsfbrloppet si kort som mojligt. 
5 Tillverkare av vaxellidor stravar darfbr att hos automatiskt styrda manuella lidor mimmera 
tidforloppet for vaxlingsfbrloppet, vilket medfbr att tidsiymden for att utfbra en estimering 
minskar varvid noggrannheten hos mAtningen minskas. 

Ett excmpel pi en metod som i realiteten kraver att mining sker i vaxlingsbgonblicket utg5rs 
10 av US 5549364. Orsaken till detta ar att ingen samtidig skattning av mass an och vagens 

Iutning. Detta innebar att estimeringsmetodiken blir beroende av tvi tidsdtskreta mattillfalien 
For att komma tillratta med den starkt biusiga hastighetssignalen kommer silunda matning att 
behova utforas under vaxlingsfbrloppet med ovan angivna problem som f&ljcL 

15 I US 6167357 bestows ett exempel pi en rekursiv metod for estimering av massan hos ett 
fordon. Enligt den beskrivna metoden sker en samtida bcst&mning av fordonets massa och en 
luftmotstindskoefficient Denna koefficient ir dock ingen variabel utan en kon s t a nt varfor 
den angivna metoden inte kan appliceras for bestamning av vigen Iutning 

20 

KORT BESKRIVNING AV UPPF1NNINGEN 

Andamalet med uppfiun ingen ar att tillhandahilla en metod for estimering av massan hos ett 
fordon och/eller vagens Iutning vilken inte kraver att matning sker specifikt under ett 
25 vaxlingsforlopp. 

Detta andarnil uppnis genom en metod for estimering av massas hos ett fordon enligt den 
kannetecknande delen av patentkravet 1. Genom att nyttja ett berikningsorgan med vilket en 
rekursiv process genererar en uppskattning av vikten hos fordonet genom nyttjandet av ett 
30 statistiskt filter nyttjande namnda indata omfattande fordonets hasfighct och en parameter 
vilken innefattar horisontell kraftpiverkan pa fordonet kan fordonets massa bestammas med 
god konvergens under nyttjandet av en statistisk representation av en vag med varierande 
\ ' Iutning. 

m 

A .35 Detta Andarnil uppnis aven genom en metod for estimering av hfeungen av den vig dar ett 
fordon framfors enligt den k&nnetecknande delen av patentkravet 13, Genom att nyttja ett 
berakningsorgan med vilket en rekursiv process genererar en uppskattning av lutningen av 

" . den vag dar ett fordon framfbrs genom nyttjandet av ett statistiskt filter nyttjande namnda 

indata omfattande fordonets hastighet och en parameter vilken innefattar horisontell 

C : 40 kraftpiverkan pa fordonet kan vigens turning bestammas med god konvergens under 
nyttjandet av en stati stisk representation av en vig med varierande Iutning. 
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I en s&rskiit fbredragen utfbringsform av uppfinningen bestams lutningen av den vag dar 
fbrdonet firamfbrs och fordonets massa samtidigt. 



I en fbredragen utfbringsform av uppfinningen nyttjas ett Kalmanfilter alternativt ett utvidgat 
Kalmanfiher s&som statistiskt fiker i en rekursiv process utgbrande en estmcringsmetod f&r 
fordonets massa och/eller lutningen av den vag dar fbrdonet framfbrs. Fordonets 
rbrelseekvation utgor i samtliga fall basekvation f&r KalmanfUtret. 

Ett Kalmanfilter ar en estimeringsmetod for linjara system vilken beaktar det statistiska 
uppfbrandet av en process och matstGmingar. AUmant beskrivs ett Kalmanfilter av systemet 
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35 



... 40 



x = Ax + Bu + v : y = Cx + Dy +w 

dar x ar en tillstindsvektor, y Sr en m&tvektor, u ar kfind systempivcrkan och v samt w ar 
stbmingsvektorer f&r process och matning. 



Ett utvidgat Kalmanfilter ar en estimeringsmetod for icke linjara system 

En djupare beskrivning av Kalmanfiher ges exempelvis i Schmitbaucr B. "Modeilbaserade 
reglersystem", studentlhteratur 1999. 

Genom metoden enhgt uppfinningen erhilles en samtidig estimering av fordonets massa samt 
lutningen av den vag dar fbrdonet framfbrs. 



I en foredagen utfbringsform utgdrs den statistiska representation av vfigens hitning av en 
f&rsta ordningens process med en intensitet d och en brytfrekevens g>c Sasom utgangsvarden 
fbr intensitet d och en brytfrekevens co c kan en uppskattning ur ett frevensspektrum fiin en 
referensvag nyttjas. Enligt en utfbringsform av uppfinningen fir det dock mbjligt att uppdater 
vardet pi parametrama d och a> 6 genom att variationen av det av processen berfiknade vardet 
pi lutningen hos vagen studeras och for tillfallet mer lampUga vfeden inf&rs, Ett sfitt fir att 
lagra lutningsestimatet i en batch och sedan (kanske varannan tsmma) kOra en vanhg RLS 
(Recursive Least Square) algoritm for att satta parametrama, dv$ man anpaasar en fbrsta 
ordningens process till en matserie. En djupare beskrivning av hur uppdatering kan 
astadkommas ges i Lcnnart Ljung, System identification- theory for the user. 

Enligt en utfbringsform av uppfinningen uppskattas den longitudineUa kraftpiverkan ur en 
uppskattning av frin en i fbrdonet ingiende forbriimungsmotor levererat moment. 
Uppskattningen skcr pi ett for fackmannen vilkint satt fran indata omfattande levererad 
branslemangd, aktuelh varvtal och fordonets hastighet. Ett exempel pi hur berakning av 
drivande moment frin fordonsdata ges i US6035252 . I en alternativ utfbringsform av 
uppfinningen uppskattas den longitudineUa kraftpiverkan genom nyttjandet av en 
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accelerometer vilken uppm&ter accelerationen i longitudincll riktning. Enligt en tredje 
utfbringsform av uppfinningen uppskattas den longitudinella kraftp&verkan av en 
momentgivare placerad i fbrdonets drivlina. 



en fbredragen utfbringsform av uppfinningen nyttjas metoden for estimering av 
fordonets mass a for fordelning av bromskraft xneilan bromsar i fordonet ingicnde slip och 

dragbil. 



10 HGUKBESKWVNING 

Uppfinningen kommer nedan art n&rmare beskrivas med hanvisning till bifbgade 
ritningsfigurer, dar 

15 fig. 1 visar schematiskt ett fordon innefattande en styrkrets fbr utforande av en metod 

for estirnering av fbrdonets massa enligt uppfinningen, 



20 



fig. 2 visar ett blockschema fbr exekvering av cn metod for estimering av fordonets 

massa enligt uppfinningen, och 

fig. 3 visar rcsultat frin simuleringar av estimeringar av massa och v&glutning under 

anv&ndning av den uppfinningsm&ssiga cstimeringsmetodcn. 



25 

UTFOWNGSFORMER 

I en fbrsta modell uppskattas v&gens turning for ett fordon med kind massa. Modellen baseras 
sig pi fordonets rfcrelseekvation i fbrdonets longitudinella riktning. Med fordonets 
30 longitudinella riktning avses riktningen l&ngs fordonets Srdvfig owaett i vilken vinkcl i 
forhillande till horisontalplanet fordonet for dgonblicket framfors i. 

Rorelseekvationen bar formen; 

m 

mv^mg sina + fp -f f 

35 

dar a &r vagens lutning, % applicerad drivkraft och f, retardatkraskrafter. Drivkraften t, utg6rs 
av positivt drivande moment frin en i fordonet ingiende motor filtrerat via fordonets 
transmission. Retardationskraften fcinnefattar retarderande krafter fran hjul, tUlsatabromsar 
och deterroinistiska delar av rullmotstand och luftmotstand. 
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Sivil appliccrad drivkraft £p som rctardadonskrafter £ betraktas som ktada iasignaler till det 
statistiska fihret. 

Vi har silunda en insignal av fbrmen: 
u(t) = f P (t) -S<t) = «t) 

Efter val av fordonets bastighet v och vigens lutning som till stflndsvariabler crhallcs fbljande 
tillst&ndsekvationer: 



771 

_y = Xj + w 



I derma modcll infers en statistisk representation av en vig med varierandc hitning. I en 
analys har frekvensspektrat hos en referensv^g mats upp. Studium av frekvensspektrat visar 
att frekvensspektrat med rclativt god noggrannhet kan approxim**s med en f&rsta ardningens 
1 5 process. Givetvis kan aven processer av hdgre ordning nyttjas med fbljd att 

tillstindsekvationernas dimension 3kar. Dot studerade referensstrtokan uppvisadc en 
brytfrekvens omf; = 0,002 cykler/m och en brusintensitet om 0.8 (rad) 2 /(cykler/m) 

Den statistiska representationen av nyttjas i ovanstiende tillstAndsekvation, varvid feljande 
20 tillst&ndsekvation erh&lles: 



x, = v x, = gx 2 + — /(f) + o x 

7ft 



A [o -«J u [«j 



25 



En ytterligare mojlighet till fbrbattring av estimering av vigens taming erhalles genom en 
fbrbattrad modeller ing av st6rkrafterna dar storkraftema modelleras med en fittsta ordningcns 
process i stall* fbr att modelleras med vitt brus. Delta ar mbjligt eftersom felet i drivande och 
bromsande moment fran motor och tillsatsbromsar, rullmotstand och hiftmotstand ar kanda 
till sin magnitud men inte till sht frekvensinnehiU. Tillstandsekvationen utokas darfiir med ett 
ytterligare tillst&nd x 3 - Sua och fir direfter foljande utseende: 



A = 



• - 
• • * 



"0 


g l/m~ 








*o" 


0 


~<D 9 0 




0 


v = 


v 3 


0 


0 -a? a 




0 




_ V 3- 



1 1 
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d&r co a ax storkraftens brytfrekvens och d fir Lntensiteten hos bruset. 

5 For art mdjliggOra samtidig estimering av fordonets massa och hitningen av vagen dfir 
fordonet framfors mlste tillstandsekvationcn utdkas med minst ctt ytteriigare tillstand 
motsvarande fordonets massa. Enligt detma utf&ringsfbrm av uppfinningen estimeras 
fordonets massa och lutningen av den vftg dar fordonet framftrs gcnom att nyttja en 
uppskattning av en variabel viiken innefattar longitudinell kraftp&verkan som i detta fell 

1 0 motsvarar applicerad drivkraft f p och retardationskrafter £ tills amm an s med en statistisk 
representation av en vkg med varierande lutning. Drivkraften uppskattas enlig en 
utfbringsfonn av uppfinningen genom att indata avseende fordonets hastighet, levererad 
branslem&ngd till fordonets cylindrar och fbreliggande varvtal hos fbibrtnningsmotoni 
transfonneras till ett varde pi drivande moment hos fbrbranningsmotom Denna transform 

15 utfors i en i fordonet ingaende processor pi ett fbr fackmannen vtik&nt sim genom nyttjande 
av berakningar och erfarenhetsm&ssiga avbildningar mellan indata och drivande moment. 
Enligt en alternativ utfbringsfonn av uppfinningen uppskattas det drivande moment et genom 
en utsignal firSn en momexrtgivarc placerad i fordonets drivlina. Det uppskattade moment et 
filtreras darefter till en drivande kraft via information omforeliggande utvaxling mellan 

20 utg&ende axel fran f&rbr&nningsmotorn och drivande hjul. 

Vi erhaller tillsammans med nyttjande av en ftrsta ordningens modell av variationen hos 
lutningen av vigen enligt vad som bcskrivits ovan foljande tillstAndsekvation; 



*3 X 3 



m m m = JC 3 = L»j 



4 



: Ekvationen ar en ickelinjSr tillstandsekvation varffcr ett utvjdgat Kalmanfifter mftste anvfindas. 
\ : . 3 0 Tillstandsekvationen ar av formen 



• ► « 



x - f(x,t) + V 



y-g(x.t) + w, 

35 



» . . 
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► - • 
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dar f (x,t) ar ickelinj&r och g(x,t) ar linj&r Vid anvandning av utvidgade Kalmaafiher 
linjariseras modellen kring estimatet av tillstindsvektorn x. Ftirefcrtdesvis nyttas 
differensekvationer i stillet for differentialekvationer i reahidsapplikationcr. Detta ger 

tillsammans med en Eulcrapproximation av tidsderivatan, x (x(t +h) - x(t))/ h, en 
5 diskretiserad till stinds ekvation enligt foljande: 

Xj(r + 1)= (l - A^Jxj + hv 2 = / 2 + hv 2 

Xj(r + l) = x^ +/rv 3 - / 3 + /rv, 

x 4 (r + 1) = (1 - h& s )r 4 + hv 4 » / 4 + Av 4 



Nasta steg fir att linjarisera ovanstaende tillstandsekvation kring estimatet av tillstandsvektom 
10 x, varvid foljande linjara tillstandsekvation erhalles: 



1 hg 
0 



0 
0 



Kf(f) - ».) h_ 



o 
o 



0 
I 
0 



*1 

0 



0 



<Sc, 



W 



15 



* » 
# » 



25 



» » * . 



Samtidig estimering av massan m hos fordone* och hitningen a av den vfig dar fordonet 
framfors ar nu mOjlig genora att nyttja ovanstaende tillstandsekvation rekursivt med nyttjande 
av fordonets hastighet v och uppgift om applicerad drivkraft fp och retardationakrafter £. 
Drivkraften fpiitgdrs av positivt drivande moment frin en i fordonct ingiende motor filtrerat 
via fordonets transmission. Retardationskraften £ innefattar retarderande kraftcr frin hjul, 
tillsatsbromsar och detenninistiska delar av rullmotstind och hiftmotstind. Fdr att erh&lla en 
stabil approximation av tillstindsvektorn avstannas processen i en fbredragen utforingsform 
nMr forarcn applicerar fkrdbromsen cftersom friktionen mellan bromsbel&gg och bromsskiva 
normah uppvisar stor stokastisk variation. 

Enligt en andra utfbringsfbnn av uppfinningen estimeras fordon^s mass a och hitningen av 
den vag dar fbrdonet framfors genom att nyttja en uppskattning av en variabel vilken 
innefattar longitudinell kraftplverkan som i detta Ml motsvarar ca inatgnal firftn en 
accelerometer som uppmater specifik kraft langs fordonets longitudinella utstrtckning 
tillsammans med en statistisk representation av en vag med varierande lutning. 



30 



> ) 
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I detta fall inf&rs en tillst&ndsvariabel x 3 som motsvarar den longitudinella acceterationen i 
tiUstitodsekvaiionen. Den longitudinella accelerationen modelleras med en forsta ordninger 
process med en brytfrekvens ©4. Vi fir en tillstinds ekvation enligt foljande: 



x 3 ~o d =^x 3 *-xv», -foj 
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Genom att anvanda insignalen a( t) frin en accelerometer kan estimeringen av hitningen hos 
den v3g dfir fordonet framf&rs geoomfBras utan direkt koppling till fordonets massa. 
Fordonets massa kan darfcr samtidigt estbneras genom nyttjande av kontrolUcraften f(t) enligt 
ovan genom relationen a(t) = - f(t)/m. Detta innebar att di insignalen frin en accelerometer 
nyttjas kan estimeringsproblemet uppdelas i tvi skilda filter, ett kinematiskt filter utan 
rorelseekvation for estirnering av vfigens lutning och ett dynamiskt filter avseende massan. 

Det dynamiska filtret utseende f&r bestfinming av massan framgir av fbljande 
tUlstandsekvation: 
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,4 = 0 Bu = [6\ C = [(o(f)-* a )] o = 



I figur 1 visas schematiskt ett kontroll system for ett fordon dfir ovan beskrivna metod kan 
till&mpas for uppskattning av lutningen av den vig dfir fordonet framfors, fordonets massa, 
altemativt samtidtg uppskattning av lutningen av den vfig dfir fordonet framfors och fordonets 
massa. 

Konstrollsystemet fir av den typ som beskrivs i patentskriften US 6167357 till vilken bfinvisas 

■ 

for en mer detaljerad beskrivning. 

Fordonet 10 innefottar en forbrtoningsmotor 1 1 och en vfixellida 12 vilken via en utg&ende 
axel 15 fbrbinder forbrfinningsmotora 11 med en drivaxcl 13 for en upps&ttmng hjul 14. 
Fbrbrfinningsmotorn 1 1 styrs av en motorkontrollenhet 16 vilken nyttjar en insignal frin ett 
gasreglage 17 och i forekommande fall en konstantfarthillare 18. FOibrfinningsmotom 1 1 och 
dess motorkontrollenhet 16 fir av konventionell typ dfir motorkontrollenhet en styr 
bransleinsprutning, motorbroms etc. efter insignaler frin gasreglage 18, hastighetsgivare 19 
och bromskontrollsy stem 20. 

Vfixeilidan 12 styrs enligt den visade utforingsformcn av en vfixdlfidekontrollenhet 21 vilken 
styr vfixlingen pi insignalen frin hastighetsgivaren 19 ahernativt frin insignalen frin en 
vaxelvfiljare 22 hos fordonet. Uppfinningcn kan fiven appiiceras pi fordon utan elekttonsikt 
styrda vfixellador. I en utforingsform av uppfinningen fir det dock nfldvfindigt att registrera 
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konvcntionell typ. 



it 20 styrs av insignaler frin ctt ferdbromsreglagc 23 saint i 
tillsatsbromsreglage 24. Fflrdelningen mellan ferdbroms o< 



tillsatsbroms kan i fbrekommande fall ske automatiskt Bromskontrollsystemet gencrerar 
ut signaler till motorkontrollsystemet 16 fbr styrning av insprutning och motoibroms i 
fbrekommande fall, till 6vriga tillsatsbromsar, exempelvis i form av cn retarder 25 vilken 
styrs av ctt kontrollorgan 26, samt till fHrdbromsama 27. 1 fbrekommande fell sker en 
fbrdelning av bromskraften mellan hos fordonet ingiendc hjulpar respective i fbrekommande 
fall ftrdbromsar 33 hos hjulpar 28, 29 p4 ett slap 30 kopplat till fordonets 10 ramstruktur 3 1 
via en koppling 32. 

Fordonet innefattar aven ctt berakningsorgan 34 fbr cstimering av massan hos ctt fordon, fbr 
15 estimering av lutningen av den vfig dfir fordonet framfers alternativt for samtidig esumering 
av massan hos ett fordon, fbr estimering av lutningen av den v*g dfir fordonet framfors. 

Berakningsorganet 34 erhiller indata frto hastighetsgivaren 19. Enligt en utforingsfonn av 
uppfinningen erhaller berakningsorganet dessutom information ftftn en accelerometer 35 
20 vilken uppmater fordonets acceleration i longitudinalled och nyttjar denna information for 
faststallande av en variabel vilken innefattar longitudinell kraftpivcrkan pi fordonet. Enligt 

incll kraftpivcrkan 



ll'JIl 



pa fordonet genom registrering av applicerad drivkraft fp och retardationskrafter F6r detta 
andamil nyttjas berakningsorganet insignaler fr&n bromskontrollorganet 20 for faststallande 

25 av storlek pi appUcerade bromskrafter, i synnerhet storleken av applicerad kraft via 

ollsatsbromsama. Vidare nyttjas insignalen frin hastighetsgivaren 19 for bestimning av 
rullmotstand och. luftmotstind. I en utfbringsfbrm av uppfinningen nyttjas information frin 
motorkontrollsystemet 16 for faststallande av avgivet moment frin fbrbranningsmotorn I en 
andra utf&ringsform av uppfinningen nyttjas insignalen firan en momentgivare 36 placerad 

30 langs fordonets drrvlina. Vidare nyttjas insignalen frin vaxelladekontrolleiiheten 21 for 
bestamning av applicerad drivkraft ur beraknat eller uppmatt drivande moment. 



MM* 



tillgangliga via 

det kommunikationssystem som nyttjas i fordonet, vanligtvis en databuss. 

Berakningsorganet 34 gencrerar utsignaler motsvarande lutningen av den vag dar fordonet 
framfors 38 ocb/eller fordonets massa 37, i beroende av vilken av de ovan beskrivna 
processer fbr bestamning av tillstandsekvationenia bestimmande fordonets rOrelse som vahs. 
Berakningsorganet 34 innefattar minnesareor och processorer varvid itcrering av den 
rekursiva processen kan ske med genering av en uppskattning av lutningen ocb/eller massan 
som foljd. 



■ a • 
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I figur 2 visas ett blockschema for exekvering av en metod for cstimering av fbrdonets massa 
enligt uppfinningen. 

m 

5 1 figuren beskrivs del principiella flodet f&r saxntida mass- och hitningsestiniering (utan 

specifik-kraft maining). Estimeringen/matningen av dragkraft och tyalpbromskraft bchandlas 
inte i dctalj. Vidare behandlas inte signalbehandlingen (filtrating osv) av ttvriga uppmatta 
signaler i detalj . 

10 Foljande beteckningar anv&nds i figuren. 

Area: Fordonets vindmotst&nd area 

Cd: Vindmotstandskoefficient 

Cr: RuDmotstSndskoefficient 

g: Gravitation skonstant 
15 hi : Uppdateringstid fbr fjhreshold 

ha: Uppdatering av lutningsprocessens parametral relativt ling tid (timmar) 

h: Samplingstid 

d : Lutningsprocessens intensitet 

e: Kraftstdmtngsprocessens intensitet 

20 

I ett forsta funktionsblock 40 uppskattas pftlagt drivande moment saint beriknad drivkraft frin 
uppskattningen av det drivande momentet. Vidare uppskattas pilagt bromsandc moment samt 
bromsande kraft fran tillsatsbromsar. Indata till det fbrsta funktionsblocket 40 utgors av en 
uppsattning vari abler inkluderande gaspedallage, motorvarvtal, insprutad brtoslcnUingd, 

25 vaxell&ge, tuibotry ck i forekommande fall, drivaxel varvtal, samt en tillstandsvariabel for 
tillsatsbroms vilken kan inkludera lufttrycket i tillsatsbroms och/eller str5mfbrs6ijning till 
elektrisk retarder. Uppskattningen av drivkraft och bromskraft frin tillsatsbromsar frin 
namnda indata utgors av konventionell av fackmannen valkand teknik och kommer darfbr inte 
att fbrklaras mer ingaende. Uppskattning av drivkraft frin n&mnda givna indata beskrivs 

30 exempelvis i Anderson B.D.O, Moire IB, QpftWlf Filtering IrffylMtim WK*$Y stiem Sconce 
Series. Prentico-Hall, University of Newcastle, New South Wales, Australia, 1979. 



• » • 



Utsignaler frin det forsta funktionsblocket utgors av en fbrsta tillstandsvariabel s(l) 
| motsvarande drivkraft och en andra tillstandsvariabel s(4) motsvarande bromskraft frin 
:"35 tillsatsbromsar. 



Dessa tva tillstandsvariabler s(l) och s(4) bildar indata till ett andra funktionsblock 50 
tillsammans med en tredje tillstandsvariabel s(3) motsvarande ett binart varde bestammande 
. . huruvida ferdbromscn anvands eller inte samt en fjarde tillstandsvariabel s(2) motsvarande 
'.'"no hastigheten hos fordonet. I det andra funktionsblocket beraknas kraften i fordonets 

longhudinelU riktning. I en forsta utforingsform av uppfinningen beraknas kraften enligt 
foljande samband: 



• * * 
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f( t ) = s (l)^ o,5Cd* Area s 2 (s) - Cr*g*s(9) - s(4) dfir s(9) ar en niondc tfllsttadsvariable 
motsvarande ett estimerat vftrde pi fbrdonets massa. Kraft en f(t) utgors av en femte 
tillstandsvariabel s(5). Vidare bildas en sj&tte tillstindsvariabel s(6) som utg6r variansen av 
kraften f(t) och nyttjas som ett troskelvarde fbr att estimering skall Mga ruin. For att erhilla 
Rod estimering ar det nddvtndigt att det dynamiska systemet excitcras tillrackligt. 



©013/ 
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20 



25 
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I en altemativ utforingsfonn av uppfinningen ersatts insignalema ersatts berakningen av 
kraften fran utsignaler fran det forsta funktionsblocket 40 racd en berakning fran en insignal 
fran ett tredje funktionsblock 60 dar insignal er fran raomentgjvare nyttjas i stallet fbr 
uppskattningar ur andra parametral-. 

Insignaler till ett fjarde funktionsblock 70 utgors av dc i det andra funktionsbtocket 50 bildade 
utsignalerna samt en sjunde tillstandsvariabel s(7), en attonde tillstandsvariabel s(8) 
motsvarande den estimerade tillstindsvektom Xest och i rorekoramande fall uppdaterade 
varden av brytfrekvensen o e och storintensheten d. I det fjarde funktionsblocket sker i ett 
fbrsta processteg en kontroll huruvida systemet ar tillrackligt exciterat fbr att estimering skall 
tillatas ske. Detta sker genom att undersbka huruvida den sjatte tillstindsvariabeln Overstiger 
ett bestamt gransvarde samt huruvida den tredje tdlstandsvariabeln ar lika med noil, vilket 
innebar att fardbroms intc nyttjas. 

Om dessa villkor ar uppfyllda definieras i ett andra processteg systemmatrisen A(t) som ar en 
funktion av s(5), s(2), h, g, w c och w t samt processtOnungsmatrisen Ri(t) vilken ar en 
funktion av s(2), d och e. Funktionernas utseenden ar givna under ovanstlende beskrivmng av 
Kalmanfiltrering. Vidare bildas matmatrisen C(t) och matstorningsmatrisen Raft) vilkas 
utseende aven framgfir under ovanstaende beskrivning av Kalmanfiltrering. 

Darefter beraknas i ett tredje processteg Ricattiekvationen, Kalmanfiltret och uppdatcras 
tillstandsvektom. Under detta processteg bildar uppskattningen av ullstandsvektorn Xest(t) en 
sjunde tillstandsvariabel s(7) och cstimeringsfelets kovariansmatris P(t) en attonde 
tillstandsvariabel s(8). 

Den optimala viktsmatrisen K(t+1) beraknas ur forhallandet: 
K(t+1) = A(t)P(t)C T (t)iiiv(C(t)P(t) C T (t) +R 2 (t)) 

Estimeringsfelets kovariansmatris P(t) beraknas ur rorhallandet: 

P(t+1) = A(t)P<t)*A T (t) - A(t)P(t)*C T (t)inv(C(t)P(t)*C T (t) + Ra(t)) C(t)*P(t) + A T (t) +Ri(t) 
UDDskattninaen av tiUstandsvektorn Xest(t) uppdatera* 



Xest(t+1) - f(Xest(t),t) - K(t*l)(y(t) - C(t)Xest8t)) 



17 16:21 FAX 0317119555 



ALBIHNii GBG 

0317119555 



fnfc t Patent- och reg.vertet 
2001 -08- 1 7 

Huvudfaxen Kossan 

Om villkoret fbr estimering inte uppfylldes i det fbrsta processtcget ersdtts i ctt fjirde 
processteg koavariansmatrisen och tillst&ndsvektom cnligt fbljande: 

P(t+l)«P(t); 
Xest(t+1) =Xest(t) 

For en djupare beskrivning av hur Ricattiekvationen och Kalmanfihret beraknas hinvisas till 
Schimdtbauer B. Kfndellbaser ^ retfersysiem. Studentlitteratur 1999. 

Utsignaler frin det fjarde funktionsblocket 70 utgors av den sjunde tfflstandsvariabeln $(7) 
och den attonde tiHstindsvariabeln s(8). Ur den sjunde tUlstandsvariabeln s(7) valjs i ett femte 
funktionsblock 80 fbrekommande fell ett estimerat varde pa massan. I ett sjatte 
funktionsblock 90 valjs i fbrekommande fell ett estimerat varde pi hrtningen av den vag dar 
fordonet framfors. 



Enligt en utftringsfbrm av uppfinningen bilda ett nytt estimerat varde av brytftekvens och 
storintensitet hos vaglutningens variation i ett sjunde funktionsblock 100. Dessa nya varden 
aterfbrs till det fj&rde funktionsblocket. 



1 figur 3 visas resultat fran kfimingar av en simuleringsmodell utnyttjande ovan beskrivna 
estimeringsmctod. Streckade linjer utgdr reella parametervarden och heldragna utgor 
estimcrade varden. I de morklagda omr&dena exciterade systcmet for svagt varvid en avdrift 
av massuppskattningen skulle ske om inget troskelkrav finns uppstalh. Observera att vigen 
lutning kan estimeras trots att estimeringen fbr massan ar avstangd. 

Uppfinningen skaU inte begninsas till ovan beskrivna utforingsfonner utan kan varieras fritt 
inom ramen fbr efterfbljande patentkrav. exempelvis kan uppfinningen aven nyttjas i fordon 
som drivs med andra motorer an fdrbranningsmotorer, exempelvia elmotorcr. 
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1) 



2) 



3) 



4) 



Mctod for estimering av massan hos ett fordon vilket framfors pi en vSg med en 
varierande hitning innefattande foljande metodstog: 

- uppmatning av fordonets hastighet for genericg av indata till ctt 
berakningsorgan; 

- uppmatning av en variabel vilken innefattar longitudincll kraftpiverkan pi 
fordonet fbr genering av indata till ett benikningsorgan, 
kannetecknad av att 

namnda berakningsorgan genom en rekursiv process genererar en uppskattning 
av vikten hos fordonet genom nyttjandet av ett statistiskt filter nyttjande namnda 
indata omfattande fordonets hastighet och namnda variabel och en statistisk 
representation av en vig med varierande Iutning. 

Metod enligt krav 1, kannetecknad av att namnda rekursiva process genererar en 
samtida uppskattning av massan hos fordonet och hitningen av den vftg dar 
fordonet framfbrs. 

Metod enligt krav 1 eller 2, kannetecknad av att namnda statistiska filter utg&rs 
av ett Kalmanfiher altemativt ett utvidgal Kalmanfilter representerande 
fordonets rorelseekvation. 

Metod enligt krav 3, kannetecknad av att fordonets hastighet och vagens hitning 
vsljs som tillstandsvariabler i namnda Kalmanfiher. 



» 



• • • 
« * 



* » * 



* * 
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5) Metod enligt nagot av foregaendc patentkrav, kannetecknad av att namnda 

statistiska representation av vagens hitning utgdrs av en forsta ordningens 
process med en intensitet d och en brytfrekevens n c . 

6) Metod enligt krav 5, kannetecknad av att storleken p& namnda intensitet d och 

brytfrekvens uppdateras ur information avseende vagens iutning gencrerad fran 
namnda rekursiva process. 

7) Metod enligt nagot av foregiende patentkrav, kannetecknad av att namnda 

parameter innefattande en longitudinell kraftpAverkan beraknas fir&n en 
uppskattning av firin en i namnda fordon ingaende motor levererat moment. 

8) Metod enligt krav 7 dar namnda motor utgdrs av en forbranningamotor, 

kannetecknad av att namnda levercrade moment uppskattas ur information om 
till foibraniiingsmotorn^6rbranningsrum levererad mfingd bransle samt 



I 0317119555 



A LB I HN J 4 GBG 

0317119555 



-» PV 



0016/025 



arbetsvarvtal hos f&rbrilnningsmotont 



Ink. t Patent- och reg.verket 
2001 -08- 1 7 

Huvudfaxen Kassan 



Mctod enligt krav 7, k&onetecknad av att nkmnda levererade mo 
firin en momentgivare placerad i anslutning till fbrdonets drivlina. 



uppskattas 



Metod enligt krav 7, 8 eller 9, kannetecknat att nimnda horisontell 
kraftpiverkan ber&knas frin namnda levererade moment och information 
avseende fbreliggande utvaxling mellan fbrbrinningsmotorn utgaende drivaxel 
och hos fordonet f&rekommande drivande hjul. . 

Metod enligt nagot av patentkraven 1-6, kannetecknad av att namnda 
parameter innefattande en horisontell kraftpiverkan uppskattas med hj&lp av en 
accelerometer vilken uppmater den accelerationen i fbrdonets langdriktning. 



t nagot av fbregAende patcntkrav, kinnetecknad att av att 
avseende fbrdonets massa nyttjas f&r bromskraftsfbrdelning mellan 
; i fordone ingiende dragbil och slap. 



Metod fbr 



-O till 



lering av hitningen av en vag dar ett fordon framfbrs 
innefattande fbljande metodsteg; 

• uppm&tning av fbrdonets hastighet f&r genering av indata till ett 
berakningsorgan; 

- uppmatning av en variabel vilken innefattar longitndinell kraftpiverkan pi 
fordonet fbr ge&ering av indata till ett berakningsorgan; 
kannetecknad av att 

namnda berakningsorgan genom en rekursiv process gencrerar en uppskattning 
av lutningen av den v&g dar fordonet framfbrs genom nyttjandet av ett 
filter nyttjande namnda indata omfattande fbrdonets hastighet och J 
variabel och en statistisk representation av en v&g med varierande lutning. 



in i it 



la 



Metod enligt krav 13, kannetecknad av att namnda statistiska filter utg&rs av ett 
Kalmanfiher alternativt ett utvidgat Kalmanfilter representerande fbrdonets 
rdrelseekvation. 

Metod enligt krav 14, kannetecknad av att fordonets hastighet och vtgens 
lutning valjs som tillst&ndsvariabler i nflmnda Kalmanfiher. 



Metod enligt nigot av patentkraven 13-15, kannetecknad av att namnda 
statistiska representation av vggens lutning utgOrs av en fbrsta ordningens 
process med en intensitet d och en brytfrekevens D c . 
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Metod cnligt krav 16, kannetecknad av att storleken pi namnda intensitct d och 
brytfrekvens O c uppdateras ur information avseende vSgens lutning gcnererad 
fran namnda rekursiva process. 



017/025 



18) 



Metod cnligt n&got av patentkraven 13 - 18, kannetecknad av att namnda 
parameter innefattande en longitudinell kraftpiverkan berdknas frin en 
uppskattning av frin en i namnda fordon ingiende motor levererat moment. 



19) 



20) 



21) 



22) 



Metod enligt krav 18 dar nimnda motor utgdrs av en fftrbranningamotor, 
kannetecknad av att namnda levererade moment uppskattas ur information om 
till fbrbranningsmotornsf&ibranningsrum lever erad mingd bransle samt 
arbetsvarvtal hos fbxbrdnningsmotorn. 

Metod enligt krav 18, kannetecknad av att nimnda levererade moment 
uppskattas firan en momentgivare placerad i anslutning till fordonets drivlina. 

Metod enligt krav 18, 19 eller 20, kinnetecknat att nimnda horisontell 
kraftpiverkan berdknas firin namnda levererade moment och information 
avseende foreliggande utvaxling mellan f&rbrflnninjamotorn utgiende drivaxel 
och hos fordonet fbrekommande drivande hjuL 

Metod enligt n&got av patentkraven 13 - 17, kannetecknad av att namnda 
parameter innefattande en horisontell kraftpiverkan uppskattas med hjftlp av en 
accelerometer vilken uppm&ter den accelerationen i fordonets ISngdriktning. 



23) 



Metod enligt nigot av patentkraven 13-22, kannetecknad att av att information 
avseende fordonets massa nyttjas for bromskraftsfordelning mellan bromsar hos 
i fordonet ingiende dragbil och slip. 
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1) 



I publikationen talas om Kalmanfiltrering respektive "extended Kalman 
filtering" 

Vilken ar skillnaden mellan dessa tva metoder och vilket begrepp omfattar bada 




i^^nKStdikrafteraa givna fran variationen av vaghitningen modelleras med ett system 

av fbrsta ordningen, I stycket 3 .2 publikationen talas om brytfrekvens □ <j med 
en intensitet d. Jag ser inte termen "d" aterkomma i ekvationerna. 



Var i ekvationerna aterfinns teimeri "d" 
processbruset (i detta fallet v&glutningsprocessen). 






Hut skulle ekvationerna se ut om st6mingen approximerades med exempelvis 
ett andra ordningens system? Ar detta mojligt? i^l^^aragfgg 




c c 

C C « 
C ( c 
c « 
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tec 
c c 
t c 
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^^^^PSasomjag har uppfattat uppfinningen nyttjas en modeUbeskrivning av den 

statistiska variationen hos vagens lutning. I detta fall beskrivs denna variation 
som □ = -D e e + □ r 

Jag har uppfattat det som att D c ar bestamd eller uppskattad genom studium av 
en referensstracka, dvs att D c betraktas som en parameter med kand storlek. 



Ar detta korrekt? ^p^^|^^^|^^^p|P^^^|^^P^^^I 



4) 
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5) 



Texten talar om en mojlighet att uppdatera parameteivardena hos 
modellbeskrivningen av den statistiska variationen hos v&gens lutning. 



Hur skulle det praktiskt gi till vaga? 





av kraftekvationens utseende eftersoni jag antog att den farms 



beskriven i din publikation. 



Kan du ge mig det korxekta utseendet? W^m^^^m^m^M^^^MM 
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Svar till fotnfttter: 

1 , Har lagt frigan vidare till motor avd. Kanske ricker det med en referens se 7 ncdan 

2, Ett lampligt stallc ar utgAendeaxel Mn vaxell&dart Detta &r dock inte heft sjfilvklart och en 
del forskning p&gar kring momenigivare i tunga fordon. 

1 > I referens 2 (bifogar stycke 2.2.3) ffcridaras ett sStt f&r bestfimning av motor moment. Jag 
vet inte ora vi gor cxakt s& men tioligen ir likheteraa stora. 

15, Senedan 

16, Om du fbrstorar bilden stir siserdu signa l namn. 

17, Fiftret fungerar- de estimeradc storheterna konvergerar mot sina riktiga varden. Bilden 
kan fbrstoras genom att markera den och sedan dra i n&gon av horn markena (om du drar i 
hftrnen behaller bilden sin proportion). 

I figuren beskrivs det principiella flodet £5r samtida mass- och lutningsestimering (utan 
specifik-kraft mitning). Estimeringen/mMningeu av dragkraft och hjalpbromskraft behandlas 
inte i detalj. Vidare behandlas inte signalbehandlingen (flittering osv) av dvriga uppmltta 

signaler i detalj. 

Nomenklatur 

Area: Fordonets vindmotst&nd area 
Cd: Vindmotstandskoefficient 
Cr. RullmotstSndskoefficient 
g: Graviutionskonstant 
hi: Uppdateringstid for fjthreshoW 

h^: Uppdatering av lutningsprocessens parametral", relativt ling tid (timmar) 
h: Samplingstid 

d : Lutningsprocessens intenshet 

e: Kraftstdmingsprocessens intensitet 
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calculation 




force s(4) 



OR 



r 



} 



S(?) 





«t>-s(l>0.5*Cd*Ai«l*9 2 (2)-Ci*g*5(9>«(4) 
%Thrcshold force, calculated in inicrvaOs of hi 
Hseconds 

f_threstaold(t>"variaiioe(Al)) 
s(5)=f(t) 

s(6)=f threshold® 



I S(6) SO) I S<3) r 

i ▼ A A—A 



HCheck conditions 
Ifs(3) =0 (AND) 8(6>>Thre$ao*d 
HDefine process 

AaHRmciioTi(s(5)^CXh.g > w«,w < j) HSysxem matrix 
C(t) WMtasuremtnt matrix 
R)(t)=fimcri(m($(2X<U) W*oeejJ noise matrix 
Ra(t) ^Measurement nose matrix 

^Calculate Rtcatti equation, Kalman filter and 
Hupdate state vector 
Xest(t)-s(7) 
P(l)-8(8) 

K(t^l)-A(tJP(t)C T tl)hiKC(QP(OC T (t>t RrfO) 
P(t*i)=A(t)P(t)M*^ 
..*C T (t)+ l^t))C(t)*P0r A T (D+ Ri(t) 
Xest<t+l>*tXestr;0^^^^ 

Else ^Condition 
P(t+l>-P(t) 
Xest(t+l)=Xest(t) 

end 

s(7>OCest(tU) 
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SAMMANDRAG 



Metod for estimering av massan hos ett fordon vilket framfors pi en vfcg med en varierande 
lutning innefattande RSljande metodsteg: 

- uppmatning av fordonets hastighct fbr genering av indata till ett bertkningsorgan; 

- uppm&tning av en variabel vilken innefattar longitudinell kraftpiverkan pa fordonet fbr 
genering av indata till ett berikningsorgi 
saint 

metod fbr estimering av hitningen av en vag d*r ett fordon framfbrs innefattande fbljande 
metodsteg: 

- uppmatning av fordonets hastighet fbr genering av indata till ett berMkningsorgan; 

- uppmatning av en variabel vilken innefattar longitudinell kraftp&verkan p4 fordonet fbr 
genering av indata till ett berakningsorgan. 
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Engine torque 
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And 

Auxiliary brake 
torque estimation 
and auxiliary 
brake force 
calculation 



Propulsion 



rorce s(l) 
Auxilary brake 



force s(4) 



[ Torque transducers j 



S(9) 



X 



Select 
MassEstiniate 



go 
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S(3) 
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akeped ( 
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%Force f(t) 

f(l)=s(l)^3*W*Area*s 2 (2>Cr*g*s(9>>s(4) 
^Threshold force, calculated in intervallsofhj 
Hseconds 

f_ihrcsliold(l)=variancc(f(t)) 
s(5)=f(t) — 
s(6)=f_llircshold(t) 



n 



S(6) 



S(2) 



S(3) ^ 



%Check conditions 

If s(3) =0 (AND) s(6)>Threshold 
%Dejine process 

ACO^functionCsC^.sCZ^^w^Wd) %6>stow matrix 
C(l) 94A'feasurement matrix 
Ri (t)=function(s(2XcLe) EProcess noise matrix 
R 2 (t) ^Measurement nose matrix 

^Calculate Ricatti equation, KaJman filter and 
%update state vector 
Xest(t)=s(7) t 
P(0=s(8) 

K(t+l)=A(t)P(t)C T (t)inv(C(t)P(t)C T (t)+ R 2 (t)) 
P(tH)=A(t)P(t)*A T (t)-A(^ 
..+C T (t)+ R 2 (0)C(t)*P(l)* A T (l)+ Ri(0 
Xest(t+lK(XesT(tM^ 



Else ^Condition 
P(t+l)=P(t) 
Xest(t+l>=Xest(t) 
end 

s(7)=Xest(t+l) 
S(8)=P(I^1) 
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